'''
这个路径规划是一个复杂的问题，主要是要考虑的问题多，采用逐个击破的方法，转化为一个个小问题。
'''
